#ifndef __CONTROL_H
#define __CONTROL_H

#include "System.h"



void suduhuansuan(float Vin,int Dir);
void Drive_Motor(float Vx, float Vy, float Vz);
//void Balance_task(void *pvParameters);
void PS2_control(void);
#endif
